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© Robot control apparatus. 

© A robot control apparatus for controlling the movement 
of an arm (7) of a robot (6) with respect to a work piece (2) 
transported upon a pallet (1) moving down an assembly line, 
wherein the position of the arm of the robot is compensated 
for in accordance with the position of the workpiece. A 
reference position memory stores a reference position of one 
of the pallet and workpiece. A position detector (16, 17) 
detects the position at which the pallet of workpiece is 
clamped along the assembly line. A difference between the 
outputs from the reference position memory and the posi- 
tion detector is used to correct a value stored in a work 
position memory to thus provide the output data which 
controls the movement of the arm of the robot. 
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ROBOT CONTROL APPARATUS 

BACKGROUND OF THE INVENTION 
The present invention relates to an industrial 
robot. More particulary, the invention relates to an 
5 apparatus for controlling the movements and work positions 
of an industrial robot. 

Industrial robots are finding a wide range of 
application, not only for dangerous tasks, but also for 
routine operations. For example, assembly robots are 
10 currently being used on production lines for supplying, 
discharging and machining parts, operations which require 
highly precise positioning. The required motions are 
repeatedly effected by a robot control apparatus with a 
predetermined, designated point serving as a reference 
15 position.. 

Production lines in which* industrial robots are 
used employ a transfer device with which products (workpieces) 
are moved along transfer lines or free flow lines. Pallets, 
for instance, may be used for the transfer device. If 
20 such pallets are positiorially displaced from the reference 
positions in the production line, robot operations may 
become erroneous, even if the robot performs the designated 
motions with high precision. Therefore, most production 
lines incorporating industrial robots have been limited to 
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situations in which the pallets can be positioned with a very 
high accuracy. In other words, most known types of indust- 
rial robot cannot be incorporated into existing production 
lines. If known robots were, on the other hand, used in 
S such production lines, the type of operation done by the 
robots was restricted due to the low accuracy of the 
transfer device. 

United States Patent Re. 30,016 discloses a 
method and apparatus for operating an industrial robot 

10 in which command signals representing the position of a 
machine element relative to a workpiece are varied as 
a function of measured unprogrammed changes in the 
relative positions of the machine element and the workpiece. 
A first signal if produced which is representative of the 

15 direction and magnitude of a change in relative position *. 
between the machine element and the workpiece. A second 
signal is produced which represents an estimate of an 
unprogrammed change in relative position during a 
queuing delay related to a number of interrupt signals. 

20 These two signals are used to modify the command signals 
which operate the machine element to cause the machine 
element to move. to the correct position relative to the 
workpiece. 

United Kingdom Patent Application 2,027,938 A 
25 describes an industrial robot system which is an improvement 
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over that described in the United States Reissue Patent. 
In the system of the United Kingdom Patent Application, a 
control memory stores data representing a precomputed optimum 

path of movement of the manipulator arm for a fixed position 
of a workpiece. Projected workpiece displacements are 
also stored therein. During playback operations^ the 
movement of the workpiece is detected and an optimum path 
computed from the precomputed fixed path solution and data 
related to the current position of the workpiece. 

Neither of those two references, however, 
describes how the position of a workpiece is to be measured 
or precisely how the position correction operation is 
performed. 

It is thus an object of the present invention to 
provide a robot control apparatus for enabling a robot 
to move stably as desired without being affected by the 
accuracy with which pallets can be positioned. 

SUMMARY OF THE INVENTION 
According to the present invention, the above 
20 object is achieved by providing a robot control apparatus 
which detects and recognizes a position in which a pallet 
or workpiece is clamped and corrects the movement of the 
robot arm in accordance with the detected values so as to 
enable the robot arm to effect required operations smoothly 
2S and stably with a high degree of flexibility. 
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BRIEF DESCRIPTION OF THE DRAWINGS 

Fig. 1 is a schematic plan view of a robot, a 
pallet clamp and a position detector; 

Fig. 2 is a block diagram of a robot control 
•apparatus according to the present invention; 

Fig, 3 is a graph showing a coordinate system 
used with the invention; 

Fig. 4 is a schematic plan view of a pallet clamp 
and a position detector according to another embodiment 
of the invention; and 

Fig. 5 is a block diagram of a robot control 
apparatus according to still another embodiment of the 
invention. 

DESCRIPTION OF THE PREFERRED EMBODIMENTS 

The present invention will be described with 
reference to the drawings which illustrate preferred 
embodiments of the invention. 

As shown in Fig. 1, a pallet 1, which supports a 
workpiece 2 at a fixed position on its upper surface, is 
fed by a transporting line, such as a transfer line or 
a free flow line, to a work position at which the pallet 1 
is secured in place by a clamp 3. The clamp 3 is actuated 
by a clamp cylinder 4 which is advanced from a retracted 
position when the pallet 1 reaches the work position to 
hold the workpiece and pallet in position by pressing the 
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pallet 1 against a reference surface 5. An industrial robot 

6 installed adjacent to the work position has an arm 7 

reciprocably movable to effect desired operations such 

as supply and discharge of parts, bolt fastening, cutting, 

etc, 

A robot control apparatus 10 according to the 
present invention, as shown in Fig. 2, includes a reference 
position memory 11, a position detector 12, a comparator 
13, work position memory 14, and a robot control unit 
15. The reference position memory 11 is implemented as 
a PROM (Programmable Read-Only Memory) in which is stored 
a reference position P Q of the pallet 1 or the workpiece 
2. The reference position P Q is represented by coordinates 
(X Q , Y Q ) in an X- Y (Cartesian) coordinate system, as 
illustrated in Fig 3. 

The position detector 12, which detects the 
position at which the pallet 1 or the workpiece 2 is 
clamped, includes an X-position sensor 16 and a Y-position 
sensor 17 which produce signals indicative of coordinate 
positions in the X - Y coordinate system. The X-position 
sensor 16 and Y-position sensor 17 may be implemented 
with contactless optical sensors of magnetic sensors, for 
example, supported on the clamp 3 for detecting the position 
of a reference pin 18 on the, workpiece 2 by generating 
signals indicative of respective positions of the reference 
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pin. The clamp 3 has a limit switch 19 which, for example, 
produces a signal representative of a condition in which 
the clamp 3 is clamping the pallet 1. 

The comparator 13 is supplied with an output 
signal from the reference position memory 11 and an output 
signal from the position detector 12, compares these signals, 
and delivers an output indicative of the result of the 
comparison (the difference between the compared signals) 
to the robot control unit 15. The work position memory 
14, which stores data corresponding to the work position 
? 1 of the robot- 6, is preferably a PROM, as in the case 
of the reference position memory 11. The robot control 
unit 15 corrects the stored data in the work position 
memory 14 with the output from the comparator 13 and drives 
the robot 6 based on the corrected data. The robot 6 
is driven by a drive device 20 such as a pulse motor. 
The output from the robot control unit 15 is in the form 
of a train of pulses, the number of which corresponds to the 
corrected data. 

Operation of the robot control apparatus thus 
constructed will now be described. The pallet 1 with the 
workpiece 2 held in position thereon is delivered in the 
direction of the arrow (Fig. 1). When the pallet 1 reaches 
the work position, the clamp cylinder 4 is actuated to 
move the clamp 3 forward from the retracted position unitl 
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it clamps the pallet 1 against the reference surface 5. The 
limit switch 19 detects when the clamping of the pallet 1 
is completed. When the limit switch 19 produces a clamp 
signal, the X-position sensor 16 and the Y-position 
sensor 17 detect an actual reference position P Q based 
on the position of the reference pin 18 and generate a 
detection signal indicative of coordinates (x Q , y Q ) of 
the reference position P Q , with the detection signal 
being supplied to the comparator 13. The comparator 13 
compares the reference values, that is., the coordinates 

(V V o£ the Teference P° sition P 0 fTom the reference 
position memory 11 with the detected values, that is, the 
coordinates (x Q , y Q ) of the actual reference position P Q 
and computes differences values (Ax, Ay) therebetween. 
The coodinates (X p Y^ of the work position P x are 
corrected by these computed difference values to provide 
corrected coordinates which represent an actual work 
position 

The robot control unit 15 is supplied with the 
corrected coordinate values (X + t c, Y ♦ Ay) and converts 
them into a corresponding number of pulses which are then 
delivered as a drive signal to the source of drive 20. 
The robot 6 is thus accurately moved to the actual work 
position P r The robot 6 returns to the original position 
I after it has carried out the desired operation. The above 
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corrective action is effected each time a pallet 1 is 
transferred to the working position. Thus, in accordance 
with the invention, the robot 6 detects the actual work 
position for each pallet 1, performs correction based 
5 on the detected position, and effects an actual operation 
based on the corrected data, with the result that the 
robot always effects the desired operation accurately. 

While in the embodiment of Fig. 1 the X-position 
sensor 16 and the Y-position sensor 17 are attached to 

10 the clamp 3, these sensors may be mounted on a position 
detector cylinder 21 separate from the clamp 3 for move- 
ment with the cylinder 21, as in the embodiment Fig. 4. 
The X-position and Y-position sensors 16, 17 however should 
perform position measurements at a fixed position which. 

IS can be determined by the stroke of the clamp cylinder 4, 
by the position detector cylinder 21, or by a stop (not 
shown) . The reference pin '18 to be detected may be 
fixed to the pallet 1 rather than to the workpiece 2, 
With such an alternative, the workpiece 2 should be 

20 positioned with respect to the pallet 1 with increased 
accuracy. The X-position and Y-position sensors 16, 17 
may directly detect a portion of the workpiece 2 or 
the pallet 1 instead of the reference pin 18. The 
clamp cylinder 4 and the position detector cyliner 21 

25 can be -arranged so that they operate in ganged relation. 
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The X-position and Y-position sensors 16, 17 
according to the embodiments of Figs. 1 and 4 are installed 
so as to have a predetermined positional relation to the 
clamp 3. Also, of course, means should be provided for 
5 driving the clamp cylinder 4 and the position detector 
cylinder 21. 

According to the embodiment shown in Fig. 5, 
the position detector 12 (the X-position and Y-position 
sensors 16, 17) are mounted on an arm 7 of the robot 6. 

10 "When the robot 6 receives a clamp completion signal, the 
arm 7 is moved closely to the pallet 1 by arm drive 
sources 22. When the arm 7 is stopped, the X-position 
and Y-position sensors 16, 17 on the arm 7 detect the 
position of the workpiece 2 or the pallet 1. The work 

15 position is corrected on the basis of the detected data,. 

and thereafter an actual robot operation is carried out. 

* 

With the embodiment of Fig. 5, it is unnecessary to install 
the position detector 12 on the conveyor apparatus, and 
thus the robot control apparatus can easily be incorporated 

20 into existing production lines. Since a desired robot 

operation is effected after the actual reference position 
Pq has been detected, the overall work efficiency, however, 
will be somewhat reduced due to the time required for the 
position detecting operation. In the arrangement illust- 

25 rated in Fig. 5, the robot control apparatus 10 temporarily 
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holds a position detection signal and supplies such a signal 
at a specified time after the position detection operation 
has been completed to start comparison and arithmetic 
operations. For this purpose, a timing generator 23 is 
provided. 

In the foregoing embodiments, the pallet 1 is 
described as being pressed against the reference surface 
5 in the direction of the Y-axis. As a consequence, the 
pallet 1 is held against the reference surface 5 with a 
considerable degree of accuracy, and no appreciable 
positional variations occur in the direction of the Y-axis. 
Therefore, the Y-position sensor 17 may be dispensed with. 
Positional differences of the pallets in the direction of 
the Y-axis can be detected with a sufficiently high accuracy 
by adding detected values from the Y-position sensor 17 
and detected values corresponding to a displacement of the 
clamp 3 as it is advanced, and the pallet position determined 
from the mean value of the sums. The robot control apparatus 
10 has been described as comparing a reference value with 
a detected value and correcting the operational position 
of the robot 6 in accordance with the results of the compari- 
son. Since such comparison and correction can be effected 
by a control unit on the robot 6, the robot control apparatus 
10 of the present invention may form a part of the control 
unit of the robot 6. Furthermore, the comparator 13 and 
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the robot control unit 15 can be implemented with a central 
processing unit (CPU) . Specifically, a microcomputer can 
be utilized as the control unit on the robot 6 so that no 
additional special-purpose device or unit is needed for 
the control apparatus of the invention. 

With the arrangement of the present invention, 
the robot detects the position of a pallet or workpiece 
and corrects the work position based on the displacement, 
if any, of the detected position from a reference position. 
As a result, the work position is accurately controlled at 
all times. The robot can easily be incorporated into pro- 
duction lines having a relatively low pallet positioning 
accuracy. In embodiments in which the workpiece or the 
pallet is positionally detected in synchronization with the 
clamp operation, the length of a movement is not made 
longer than what is needed to effect the desired robot 
motions. In the embodiments in which the position detector 
is mounted on the robot arm, existing transfer arrangements 
can be utilized without modification. In a yet further 
embodiment, the position detector can be implemented with 
a television camera. 
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CLAIMS 



1. A robot control apparatus for reciprocably moving 
an arm of a robot with respect to a pallet transferred and clamped 
in position of a workpiece supported on such a pallet to effect 
a desired operation, comprising: reference position memory means 
5 for storing a reference position of one of said pallet and 
workpiece; position detecting means for detecting a position at 
which one of said and pallet workpiece is clamped; comparator 
means for comparing outputs from said reference position memory 
means and said position detecting means for providing a 
10 difference therebetween; work position memory means for storing 
a work position of said robot; and robot control means for 
correcting a stored value in said work position memory means 
in accordance with an output from said comparator means. 

2. The robot control apparatus according to claim 1, 
wherein said position detecting means is located adjacent to 

a position where said pallet can be clamped. 

3. The robot control apparatus according to claim 1, 
wherein said position detecting means is attached to an arm 

of said robot. 

4. The Tobot control apparatus according to claim 1, 
wherein said position detecting means comprises horizontal and 
vertical position sensing means. 
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5. The robot control apparatus according to 
claim 1, wherein said position detecting means comprises 
vertical position sensing means only. 

6. The robot control apparatus according to 
claim 1, further comprising a reference pin fixed to 
said pallet. 

7. The robot control apparatus according to 
claim 1, further comprising a reference pin fixed to said 
workpiece. 

8. The robot control apparatus of any one of 
claims 1-7, wherein said position detecting means comprises 
optical sensing means. 

9. The robot control apparatus of any one of 
claims 1-7, wherein said position detecting means comprises 
a television camera. 

♦ 10. The robot control apparatus of any one of 
claims 1-7, wherein said position detecting means comprises 
magnetic sensing means. 
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FIG. 4 
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